package edu.wpi.first.wpilibj.templates.subsystems;



import edu.wpi.first.wpilibj.templates.commands.DriveWithJoystick;
import edu.wpi.first.wpilibj.command.Subsystem;
import edu.wpi.first.wpilibj.templates.commands.SetGameDrive;
import edu.wpi.first.wpilibj.templates.commands.SetArcadeDrive2;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.templates.OI;
import edu.wpi.first.wpilibj.templates.RobotTemplate;
import edu.wpi.first.wpilibj.command.Command;
import edu.wpi.first.wpilibj.Victor;
import edu.wpi.first.wpilibj.templates.commands.CutSpeed;

public class Chassis extends Subsystem {
   
    public static final int ARCADE = 1;
    public static final int GAME=2;
    public static int driveFlag=ARCADE;
    public static final int CUT=3; 
  
    
    
    
    
  public static  Victor victor1 = new Victor(1);
  public static  Victor victor2 = new Victor(2);
  public static  Victor victor3 = new Victor(3);
  public static  Victor victor4 = new Victor(4);
    

   
  
   
   public static RobotDrive drive;
    
     

    public void initDefaultCommand() {
        
        setDefaultCommand(new DriveWithJoystick());
       
    }
    
     public Chassis() {
     
     
      // drive = new RobotDrive( victor4, victor1, victor2,victor3);
        drive = new RobotDrive( victor2 ,victor3);
        drive.setSafetyEnabled(false);
        
       
            }
     
    public void driveWithJoystick(Joystick stick) {
         switch(Chassis.driveFlag) {
             case Chassis.ARCADE:
                 drive.arcadeDrive(stick);
                 break;
             case GAME:
                 drive.arcadeDrive(stick, 2, stick,4);
                 break;
             
                 
    }
     
     
    }
}
